#include "OptionTrack.h"
#include "Ano_DT.h"
#include "Ano_OF.h"
Optitrack_Get_Data The_Optitrack_Get_Data;


void Opti_Process()
{
	
	

	The_Optitrack_Get_Data.Raw_Speed_x=The_Optitrack_Get_Data.x-The_Optitrack_Get_Data.last_x;
	The_Optitrack_Get_Data.Raw_Speed_y=The_Optitrack_Get_Data.y-The_Optitrack_Get_Data.last_y;
	The_Optitrack_Get_Data.Raw_Speed_z=The_Optitrack_Get_Data.z-The_Optitrack_Get_Data.last_z;
	
	
	The_Optitrack_Get_Data.Speed_x+=(The_Optitrack_Get_Data.Raw_Speed_x-The_Optitrack_Get_Data.Speed_x)*0.6f;
	The_Optitrack_Get_Data.Speed_y+=(The_Optitrack_Get_Data.Raw_Speed_y-The_Optitrack_Get_Data.Speed_y)*0.6f;
	The_Optitrack_Get_Data.Speed_z+=(The_Optitrack_Get_Data.Raw_Speed_z-The_Optitrack_Get_Data.Speed_z)*0.6f;
	
	
	The_Optitrack_Get_Data.last_x=The_Optitrack_Get_Data.x;
	The_Optitrack_Get_Data.last_y=The_Optitrack_Get_Data.y;
	The_Optitrack_Get_Data.last_z=The_Optitrack_Get_Data.z;
	The_Optitrack_Get_Data.T=GetSysTime_us();
	The_Optitrack_Get_Data.Hz=1/((The_Optitrack_Get_Data.T-The_Optitrack_Get_Data.Last_T)/10e6);
	The_Optitrack_Get_Data.Last_T=The_Optitrack_Get_Data.T;
	//ANO_DT_SendString("ok x");
	of_check_f[0] = 1;
	//ANO_DT_SendCenterPos(The_Optitrack_Get_Data.x,The_Optitrack_Get_Data.y,The_Optitrack_Get_Data.z);
	
}

